home *** CD-ROM | disk | FTP | other *** search
/ QRZ! Ham Radio 8 / QRZ Ham Radio Callsign Database - Volume 8.iso / mac / files / t_sys5 / 92052tar.gz / 920528.tar / axip.c < prev    next >
C/C++ Source or Header  |  1992-05-14  |  9KB  |  356 lines
  1. /* @(#) $Header: axip.c,v 1.7 92/05/14 13:19:46 deyke Exp $ */
  2.  
  3. #include "global.h"
  4.  
  5. #include <sys/types.h>
  6.  
  7. #include <netinet/in.h>
  8. #include <netinet/in_systm.h>
  9. #include <netinet/ip.h>
  10. #include <stdio.h>
  11. #include <stdlib.h>
  12. #include <string.h>
  13. #include <sys/socket.h>
  14.  
  15. extern char *sys_errlist[];
  16. extern int errno;
  17.  
  18. #include "mbuf.h"
  19. #include "iface.h"
  20. #include "timer.h"
  21. #include "internet.h"
  22. #include "netuser.h"
  23. #include "ax25.h"
  24. #include "socket.h"
  25. #include "trace.h"
  26. #include "pktdrvr.h"
  27. #include "cmdparse.h"
  28. #include "hpux.h"
  29.  
  30. #define MAX_FRAME       2048
  31.  
  32. struct axip_route {
  33.   char call[AXALEN];
  34.   struct sockaddr_in addr;
  35.   struct axip_route *next;
  36. };
  37.  
  38. static int sock = -1;
  39. static struct axip_route *Axip_routes;
  40. static struct iface *Axip_iface;
  41.  
  42. static int axip_raw __ARGS((struct iface *iface, struct mbuf *data));
  43. static void axip_recv __ARGS((void *argp));
  44. static void axip_route_add __ARGS((char *call, const struct sockaddr_in *addr));
  45. static int doaxiproute __ARGS((int argc, char *argv [], void *p));
  46. static int doaxiprouteadd __ARGS((int argc, char *argv [], void *p));
  47. static int doaxiproutedrop __ARGS((int argc, char *argv [], void *p));
  48.  
  49. /*---------------------------------------------------------------------------*/
  50.  
  51. static const int16 fcstab[256] = {
  52.   0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
  53.   0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
  54.   0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
  55.   0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
  56.   0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
  57.   0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
  58.   0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
  59.   0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
  60.   0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
  61.   0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
  62.   0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
  63.   0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
  64.   0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
  65.   0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
  66.   0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
  67.   0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
  68.   0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
  69.   0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
  70.   0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
  71.   0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
  72.   0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
  73.   0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
  74.   0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
  75.   0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
  76.   0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
  77.   0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
  78.   0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
  79.   0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
  80.   0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
  81.   0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
  82.   0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
  83.   0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
  84. };
  85.  
  86. /*---------------------------------------------------------------------------*/
  87.  
  88. static int axip_raw(iface, data)
  89. struct iface *iface;
  90. struct mbuf *data;
  91. {
  92.  
  93.   char (*mpp)[AXALEN];
  94.   char *dest;
  95.   char *p;
  96.   char buf[MAX_FRAME];
  97.   int cnt;
  98.   int l;
  99.   int multicast;
  100.   int16 fcs;
  101.   struct axip_route *rp;
  102.   struct mbuf *bp;
  103.  
  104.   dump(iface, IF_TRACE_OUT, iface->type, data);
  105.   iface->rawsndcnt++;
  106.   iface->lastsent = secclock();
  107.  
  108.   fcs = 0xffff;
  109.   for (bp = data; bp; bp = bp->next) {
  110.     p = bp->data;
  111.     for (cnt = bp->cnt; cnt > 0; cnt--)
  112.       fcs = (fcs >> 8) ^ fcstab[(fcs ^ *p++) & 0xff];
  113.   }
  114.   fcs ^= 0xffff;
  115.   bp = ambufw(2);
  116.   bp->data[0] = fcs;
  117.   bp->data[1] = fcs >> 8;
  118.   bp->cnt = 2;
  119.   append(&data, bp);
  120.  
  121.   if (iface->trace & IF_TRACE_RAW)
  122.     raw_dump(iface, -1, data);
  123.  
  124.   l = pullup(&data, buf, sizeof(buf));
  125.   if (l <= 0 || data) {
  126.     free_p(data);
  127.     return (-1);
  128.   }
  129.  
  130.   dest = buf;
  131.   p = dest + AXALEN;
  132.   while (!(p[6] & E)) {
  133.     p += AXALEN;
  134.     if (!(p[6] & REPEATED)) {
  135.       dest = p;
  136.       break;
  137.     }
  138.   }
  139.  
  140.   multicast = 0;
  141.   for (mpp = Ax25multi; (*mpp)[0]; mpp++) {
  142.     if (addreq(dest, *mpp)) {
  143.       multicast = 1;
  144.       break;
  145.     }
  146.   }
  147.   for (rp = Axip_routes; rp; rp = rp->next)
  148.     if (multicast || addreq(rp->call, dest))
  149.       sendto(sock, buf, l, 0, (struct sockaddr *) & rp->addr, sizeof(rp->addr));
  150.  
  151.   return l;
  152. }
  153.  
  154. /*---------------------------------------------------------------------------*/
  155.  
  156. static void axip_recv(argp)
  157. void *argp;
  158. {
  159.  
  160.   char *bufptr;
  161.   char *p;
  162.   char *src;
  163.   char buf[MAX_FRAME];
  164.   int cnt;
  165.   int fromlen;
  166.   int hdr_len;
  167.   int l;
  168.   int16 fcs;
  169.   struct ip *ipptr;
  170.   struct sockaddr_in from;
  171.  
  172.   fromlen = sizeof(from);
  173.   l = recvfrom(sock, buf, sizeof(buf), 0, (struct sockaddr *) & from, &fromlen);
  174.   if (l <= sizeof(struct ip )) goto fail;
  175.   ipptr = (struct ip *) buf;
  176.   hdr_len = 4 * ipptr->ip_hl;
  177.   bufptr = buf + hdr_len;
  178.   l -= hdr_len;
  179.   if (l <= 2) goto fail;
  180.  
  181.   fcs = 0xffff;
  182.   p = bufptr;
  183.   for (cnt = l; cnt > 0; cnt--)
  184.     fcs = (fcs >> 8) ^ fcstab[(fcs ^ *p++) & 0xff];
  185.   if (fcs != 0xf0b8) goto fail;
  186.   l -= 2;
  187.  
  188.   p = src = bufptr + AXALEN;
  189.   while (!(p[6] & E)) {
  190.     p += AXALEN;
  191.     if (p[6] & REPEATED)
  192.       src = p;
  193.     else
  194.       break;
  195.   }
  196.   axip_route_add(src, &from);
  197.  
  198.   net_route(Axip_iface, Axip_iface->type, qdata(bufptr, l));
  199.   return;
  200.  
  201. fail:
  202.   Axip_iface->crcerrors++;
  203. }
  204.  
  205. /*---------------------------------------------------------------------------*/
  206.  
  207. int axip_attach(argc, argv, p)
  208. int argc;
  209. char *argv[];
  210. void *p;
  211. {
  212.   char *ifname = "axip";
  213.  
  214.   if (Axip_iface || if_lookup(ifname) != NULLIF) {
  215.     printf("Interface %s already exists\n", ifname);
  216.     return (-1);
  217.   }
  218.  
  219.   sock = socket(AF_INET, SOCK_RAW, AX25_PTCL);
  220.   if (sock < 0) {
  221.     printf("cannot create raw socket: %s\n", sys_errlist[errno]);
  222.     return (-1);
  223.   }
  224.  
  225.   Axip_iface = callocw(1, sizeof(struct iface ));
  226.   Axip_iface->addr = Ip_addr;
  227.   Axip_iface->name = strdup(ifname);
  228.   Axip_iface->hwaddr = mallocw(AXALEN);
  229.   addrcp(Axip_iface->hwaddr, Mycall);
  230.   Axip_iface->mtu = 256;
  231.   setencap(Axip_iface, "AX25");
  232.   Axip_iface->raw = axip_raw;
  233.   Axip_iface->sendcrc = 1;
  234.   on_read(sock, axip_recv, (void * ) 0);
  235.   Axip_iface->next = Ifaces;
  236.   Ifaces = Axip_iface;
  237.  
  238.   return 0;
  239. }
  240.  
  241. /*---------------------------------------------------------------------------*/
  242.  
  243. static void axip_route_add(call, addr)
  244. char *call;
  245. const struct sockaddr_in *addr;
  246. {
  247.   struct axip_route *rp;
  248.  
  249.   for (rp = Axip_routes; rp && !addreq(rp->call, call); rp = rp->next) ;
  250.   if (!rp) {
  251.     rp = malloc(sizeof(*rp));
  252.     addrcp(rp->call, call);
  253.     rp->next = Axip_routes;
  254.     Axip_routes = rp;
  255.   }
  256.   rp->addr = *addr;
  257. }
  258.  
  259. /*---------------------------------------------------------------------------*/
  260.  
  261. static struct cmds Axipcmds[] = {
  262.   "route",  doaxiproute, 0, 0, NULLCHAR,
  263.   NULLCHAR, NULLFP,      0, 0, NULLCHAR
  264. };
  265.  
  266. int doaxip(argc, argv, p)
  267. int argc;
  268. char *argv[];
  269. void *p;
  270. {
  271.   return subcmd(Axipcmds, argc, argv, p);
  272. }
  273.  
  274. /*---------------------------------------------------------------------------*/
  275.  
  276. static struct cmds Axiproutecmds[] = {
  277.   "add",    doaxiprouteadd,  0, 3, "axip route add <call> <host>",
  278.   "drop",   doaxiproutedrop, 0, 2, "axip route drop <call>",
  279.   NULLCHAR, NULLFP,          0, 0, NULLCHAR
  280. };
  281.  
  282. static int doaxiproute(argc, argv, p)
  283. int argc;
  284. char *argv[];
  285. void *p;
  286. {
  287.  
  288.   char buf[AXBUF];
  289.   struct axip_route *rp;
  290.  
  291.   if (argc >= 2)
  292.     return subcmd(Axiproutecmds, argc, argv, p);
  293.  
  294.   printf("Call       Addr\n");
  295.   for (rp = Axip_routes; rp; rp = rp->next)
  296.     printf("%-9s  %s\n",
  297.         pax25(buf, rp->call),
  298.         inet_ntoa(ntohl(rp->addr.sin_addr.s_addr)));
  299.   return 0;
  300. }
  301.  
  302. /*---------------------------------------------------------------------------*/
  303.  
  304. static int doaxiprouteadd(argc, argv, p)
  305. int argc;
  306. char *argv[];
  307. void *p;
  308. {
  309.  
  310.   char call[AXALEN];
  311.   int32 ipaddr;
  312.   struct sockaddr_in addr;
  313.  
  314.   if (setcall(call, argv[1])) {
  315.     printf("Invalid call \"%s\"\n", argv[1]);
  316.     return 1;
  317.   }
  318.   if (!(ipaddr = resolve(argv[2]))) {
  319.     printf(Badhost, argv[2]);
  320.     return 1;
  321.   }
  322.   memset(&addr, 0, sizeof(addr));
  323.   addr.sin_family = AF_INET;
  324.   addr.sin_addr.s_addr = htonl(ipaddr);
  325.   axip_route_add(call, &addr);
  326.   return 0;
  327. }
  328.  
  329. /*---------------------------------------------------------------------------*/
  330.  
  331. static int doaxiproutedrop(argc, argv, p)
  332. int argc;
  333. char *argv[];
  334. void *p;
  335. {
  336.  
  337.   char call[AXALEN];
  338.   struct axip_route *rp, *pp;
  339.  
  340.   if (setcall(call, argv[1])) {
  341.     printf("Invalid call \"%s\"\n", argv[1]);
  342.     return 1;
  343.   }
  344.   for (pp = 0, rp = Axip_routes; rp; pp = rp, rp = rp->next)
  345.     if (addreq(rp->call, call)) {
  346.       if (pp)
  347.     pp->next = rp->next;
  348.       else
  349.     Axip_routes = rp->next;
  350.       free(rp);
  351.       break;
  352.     }
  353.   return 0;
  354. }
  355.  
  356.